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INTRODUCTION 


Digital  controls  are  rapidly  emerging  as  attractive  design  options  for  mechanical 
machinery  and  vehicle  systems.  The  need  to  consider  digital  controllers  as  a  design 
option  is  dictated  by  the  ever  stringent  constraints  on  design  while  attempting  to  meet 
the  increasing  expectations  of  design  functionality  and  performance.  The  feasibility  and 
the  economic  viability  of  this  opportunity  are  being  stimulated  by  the  expanding  com¬ 
mercial  availability  of  off-the-shelf  microprocessors  for  a  broader  range  of  application 
specifications.  Further  possibilities  for  digital  controllers  are  made  possible  by  the 
availability  of  relatively  inexpensive  and  reliable  sensors,  actuators,  and  input/output 
devices. 

An  increasing  number  of  products  and  systems  in  a  variety  of  end  use  applications 
are  being  influenced  by  the  digital  control  design  option,  for  example:  1.  consumer 
products  such  as  washing  machines,  lawn  mowers,  other  appliances;  2.  industrial 
machinery  such  as  mining  equipment,  conveyors/feeders,  turbomachinery;  3.  on  and 
off  road  vehicle  systems  including  suspensions,  brakes,  steering,  power  trains;  4. 
manufacturing  equipment  including  machine  tools,  robots,  end  effectors;  and  5. 
defense/aerospace  systems,  among  others.  A  trend  towards  the  increased  deployment 
of  digital  controls  in  mechanical  systems  can  be  very  beneficially  enhanced  by  a 
cohesive,  rational,  and  broad-based  computer-aided  engineering  environment  for  the 
design  of  these  controlled  mechanical  systems.  A  computer-aided  engineering  (CAE) 
environment  for  the  modeling,  design,  and  control  of  mechanical  systems  of  the  type 
mentioned  above  is  described  in  this  report.  This  environment  for  controlled  mechani¬ 
cal  systems  will  be  referred  to  by  the  acronym  CAEE-CMS. 

Controlled  Mechanical  Systems 

Typically,  a  controlled  mechanical  system  is  comprised  of  the  following 
subsystems: 

•  A  multibody,  dynamic  system  characterized  by  geometrically  con¬ 
strained,  nonlinear  (i.e.,  large  displacement)  behavior.  Further,  structural  flexibility, 
lumped  springs  and  dampers,  disturbances,  and  a  variety  of  control  forces  and  torques 
must  be  included  in  the  model  of  the  mechanical  system,  as  appropriate.  The  passive 
spring  and  damper  elements  may  be  nonlinear,  in  addition  to  producing  nonlinear 
geometric  effects  on  the  system  behavior. 

•  A  broad  variety  of  sensors  must  be  modeled  and  included  in  the 
system,  such  as  resolvers,  tachometers,  rate  gyros,  accelerometers,  and  others. 

•  Similarly,  actuators  and  their  dynamic  models  must  be  included  in  the 
system  design  process.  For  example,  the  actuators  may  include  electrical,  hydraulic,  or 
pneumatic  systems,  or  some  combination  of  these. 
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•  For  digital  control  systems,  the  effects  of  D/A’s,  A/D’s,  and  computation 
and  transmission  delays  must  be  included  in  the  system  design  considerations. 

Computer  Aided  Engineering  (CAE)  Tools 

In  recent  years,  a  number  of  CAE  tools  have  been  developed  and  accepted  in 
industrial  design  practice  for  the  design  of  the  various  subsystems  which  comprise  a 
controlled  mechanical  system.  Relevant  CAE  tools  for  the  various  subsystems  include: 

•  Geometric  modeling  tools  and  the  associated  interactive  graphics  for  the 
design  and  modeling  of  mechanical  components.  Many  of  the  commercial  CAD  sys¬ 
tems  fall  in  this  category,  particularly  if  they  allow  modeling  of  solids  and  surfaces.  The 
primary  use  of  these  systems  for  the  CAEE-CMS  is  in  the  computation  of  component 
mass  properties,  the  creation  of  a  mechanical  model,  and  a  graphics  links  to  finite 
element  modeling  tools.  A  realistic  animation  of  the  system's  dynamic  motion  for  a 
visual  check  of  the  system  behavior  under  controlled  conditions  for  various  system 
disturbances  can  be  depicted.  Detection  of  collisions  between  various  parts  and  their 
interference  checks  is  a  particularly  beneficial  capability  in  a  geometric  modeling  tool  for 
evaluating  the  spatial  motions  of  the  mechanical  system. 

•  A  variety  of  finite  element  modeling  (FEM)  and  finite  element  analysis 
(FEA)  tools  are  available;  many  are  interfaced  to  commercial  geometric  modeling  tools 
while  some  have  their  own  geometric  modeling  utilities.  The  use  of  the  FEM/FEA  tools 
within  the  context  of  a  CAEE-CMS  is  in  the  modeling  of  structurally  flexible  modal 
components  of  the  multibody  system.  The  resulting  modal  characteristics  (i.e.,  the 
natural  frequencies  and  mode  shapes  of  the  appropriately  retained  modes  within  the 
frequency  range  of  interest  for  a  specific  body)  can  then  be  incorporated  within  the 
system  model  of  the  multibody  system  by  the  modal  synthesis  technique  or  one  of  its 
variants  (refs  1  and  2).  In  those  situations  where  such  modal  synthesis  techniques  are 
applicable,  mostly  for  vibratory  response  around  a  reference  position  of  the  mechanical 
system,  the  coupling  between  the  FEM/FEA  tools  and  a  multibody  analysis  tool  can  be 
accomplished  (ref  3).  For  situations  where  the  interface  between  modal  modeling  and 
the  multibody  dynamics  system  model  may  result  in  approximations  due  to  "linearization 
too  early"  errors,  a  combined  derivation  of  the  component  mass  and  stiffness  matrices 
has  been  developed  by  starting  with  the  element  displacement  fields  and  using  the 
system  velocities  and  accelerations  for  creating  a  system  model  (refs  4  and  5). 

•  A  number  of  CAE  tools  for  multibody  dynamic  analysis  are  commercially 
available,  for  example,  IMP  (ref  6),  ADAMS  (ref  7),  and  DADS  (ref  8).  New  codes, 
largely  based  upon  Kane’s  method  (ref  9)  are  also  becoming  available,  some  using 
symbolic  processing  of  Kane's  formulation  to  produce  customized  codes  for  the  specific 
system's  equations  of  motion  (ref  10). 
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e  A  variety  of  CAE  tools  for  control  system  analysis,  synthesis,  and  design 
are  commercially  available  for  personal  computers,  workstations,  and  mainframes. 
Examples  include:  CC,  Ctrl-C/Model-C,  autocon,  MATRIXx,  design  engine,  among 

others  {ref  1 1). 

These  various  CAE  tools  constitute  a  well  established  tool  kit  for  the  modeling, 
simulation,  design,  and  control  of  dynamic  mechanical  systems.  The  CAEE-CMS  (fig. 
1 )  is  an  integrated  design  environment  where  selected  tools  from  each  of  the  above 
categories  can  be  used  in  concert  for  the  design  of  controlled  mechanical  systems.  The 
following  tools  were  selected  for  creating  the  integrated  environment: 

•  MATRIXx.  This  system  incorporates  classical  and  modern  control  design 

procedures  for  the  design,  synthesis,  and  analysis  of  control  strategies.  Component 
models  of  electrical,  hydraulic,  or  pneumatic  actuators  and  models  of  mechanical 
subsystems  can  be  created  in  MATRIXx  to  investigate  such  control  strategies  as  PID, 

LQG/LTR,  Adaptive,  and  H-infinity,  among  others.  MATRIXx  assists  the  designer  with 

time  and  frequency  domain  analysis  and  design  techniques,  and  is  a  versatile  tool  for 
control  system  design.  One  of  the  unique  features  of  MATRIXx  is  its  AUTOCODE 

function.  AUTOCODE  produces  an  optimized  source  code  in  FORTRAN,  C,  or  ADA 
from  the  block  diagram  representation  of  the  control  laws.  This  source  code  can  be 
compiled,  linked,  and  downloaded  to  an  on-board  computer  as  a  controller  to  drive  the 
actual  physical  system  with  appropriate  A/D  and  D/A  facilities  to  interact  with  the  sen¬ 
sors  and  actuators  of  the  physical  system. 

o  IMP  (Integrated  Mechanisms  Program).  The  IMP  system  performs  the 
kinematic,  static,  and  dynamic  analysis  of  multibody  mechanical  systems.  It  can  also  be 
made  to  output  transfer  functions  and  simulated  sensor  values. 

•  GMS  (Geometric  Modeling  System).  The  GMS  program  is  a  3D  solids 
modeling  program  to  model  the  physical  components  of  a  mechanical  system.  The 
GMS  program  can  also  be  used  to  computer  the  mass,  mass  moments  of  inertia,  and 
section  properties  of  the  modeled  components.  The  associated  software  package 
called  LYNX2  acts  as  a  preprocessor  and  postprocessor  for  IMP.  Shaded  image 
animation  of  the  dynamic  behavior  of  a  mechanical  system  as  computed  by  IMP  is 
displayed  by  the  LYNX2  system  on  the  Silicone  Graphics,  Inc.  IRIS  computer  graphics 
workstation  (ref  12). 

•  COSMOS/M.  COSMOS/M  Is  a  finite  element  analysis  program  which  is 
used  to  conduct  static  stress  and  dynamic  analyses  of  flexible  structural  components 
(ref  3). 
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The  standard  control  system  design  and  synthesis  techniques  are  based  on  linear 
system  theory.  In  most  cases,  multibody  mechanical  systems  are  nonlinear;  therefore, 
a  transfer  function  representation  of  the  mechanical  system,  linearized  about  a  refer¬ 
ence  position,  is  needed.  This  linearized,  s-domain  representation  of  the  system  pro¬ 
vides  the  structural  model  parameters  for  the  integration  between  IMP  and  MATRIXx  for 

producing  the  FORTRAN  code  for  the  designed  control  laws  is  another  primary  integra¬ 
tion  requirement  which  resulted  in  the  selection  of  MATRIXx  for  the  integrated  environ¬ 
ment.  The  GMS  and  IMP  programs  are  presently  interfaced  in  LYNX2,  and  the 
COSMOS/M  to  CAEE-CMS  interface  is  slated  for  future  work.  Therefore,  the  remainder 
of  this  report  will  focus  on  the  integration  process  between  IMP  and  MATRIXx  to  dem¬ 
onstrate  the  integrated  environment. 


INTEGRATION  OF  IMP  AND  MATRIXx 


A  conceptual  block  diagram  for  the  IMP  and  MATRIXx  integration  is  shown  in 

figure  2.  The  specific  details  of  the  block  diagram  will  become  clear  during  the  following 
discussion. 

Transfer  Functions 

The  concept  of  transfer  functions  of  multibody  mechanical  systems  is  similar  to  the 
transfer  functions  for  linear  models  but  with  some  important  differences.  For  a  simple 
spring-mass-damper  linear  system,  the  equation  of  motion: 

M  •  X(t)+c  ^  •  X(t)  +  K  X(t)  =  F(t)  (1) 


This  differential  equation  in  the  time-domain  can  be  converted  to  the  s-domain: 


[M  s2  +C  s  +  K] 


•  X(s)  =  F(s)  or 


m  _  i 

F(s)  M  s2+C  s  +  K 


(2) 


where 

s  =  jd)  and  J  =  \f-1 
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The  expression  of  equation  2  is  normally  referred  to  as  the  transfer  function 
relating  the  displacement  X(s)  to  the  force  F(s)  and  can  be  represented  by  a  sum  of 
complex  numerators  and  denominators  as: 


X{s)  _  N,  N2 
F(s)  s  -  Di  +  s  -  D2 


(3) 


Where  N1  and  N2  are  complex  conjugates  of  each  other,  and  the  denominator  terms  D( 
and  D2  are  also  complex  conjugates  of  each  other.  D,  and  D2  are  also  the  system 
eigenvalues.  For  this  simple  case,  assuming  an  underdamped  system, 


^  -C  .  V4  K  ■  M  -  C2 

Ui  "  2  •  M  +  1 '  2  M 


D 


-C 

2  ~  2  •  M 


-  C2 

2  ■  M 


(4) 


N,  =  -i 


1 


V4  •  K  M-C2 


_ 1 _ 

V4  K  M  -  C2 


(5) 


For  a  single  degree  of  freedom  system,  equation  3  shows  that  two  numerator  and 
denominator  ratios  are  obtained;  these  are  complex  conjugate  pairs,  i.e.,  N,  and  N2,  D, 

and  D2.  For  an  n  degree  of  freedom  system,  the  general  form  of  the  transfer  function  is: 


X(s)  _  N,  N2  N3  _ N4 _ 

F(s)  -  s  -  D,  +  s~-  D2  +  s -D3  +  s  -  D4  +  '  '  ' 

N2n  1  N2n 
+  +  s'TJS 


(6) 


Where  N1  and  N2,  D,  and  D2  are  complex  conjugate  pairs;  N3  and  N4,  D3  and  D4  are 

complex  conjugate  pairs,  and  so  on.  There  are  2n  ratios  in  the  transfer  function  of 
equation  6. 

Multibody,  constrained  mechanical  systems  are  inherently  nonlinear  systems 
because  of  the  large  geometry  changes  during  their  motion.  The  concept  of  transfer 
functions  is  applicable  to  linear  systems  only.  Therefore,  for  the  multibody  systems,  the 
transfer  functions  can  only  be  valid  for  small  vibratory  motions  around  an  operating 
point,  such  as  a  static  equilibrium  position.  Further,  the  spring-mass-damper  models 
are  greatly  idealized  models.  In  the  multibody  systems  of  the  type  considered  in  this 
report,  a  typical  model  may  be  represented  by  a  collection  of  links,  joints,  springs, 
damoers,  and  excitations  of  forces  and  motions  (fig.  3).  Although  IMP  is  a  3- 
dimensional  analysis  system,  figure  3  is  shown  as  a  2-dimensional  system  for  clarity  in 
presenting  the  concepts  without  having  to  interpret  the  spatial  complexity.  In  this  sys¬ 
tem,  BASE  is  a  fixed  body  with  respect  to  the  XY  inertial  frame;  TANK  slides  relative  to 
BASE  in  the  X  direction;  LI  is  connected  to  TANK  by  a  revolute  joint;  L2  is  connected 
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by  a  revolute  joint  to  LI  and  to  L3  by  another  revolute  joint;  L3  is  connected  to  L4  by  a 
revolute  joint,  while  L4  is  connected  by  a  prismatic  joint  to  TANK.  The  symbolic  names 
of  the  various  revolute  and  prismatic  joints  are  also  defined  in  figure  3.  The  Kinematic 
degrees  of  freedom  of  this  system  is  3;  the  IMP  sy  stem  automatically  identifies  the 
degrees  of  freedom  by  an  algorithm  based  on  the  rank  of  the  instantaneous  system 
geometry  matrix.  IMP  also  identifies  the  appropriate  generalized  coordinates,  or  motion 
variables,  as  the  independent  variables  at  the  instantaneous  configuration  of  the  me¬ 
chanical  system. 

For  the  system  shown  in  figure  3,  if  the  X  and  the  Y  positions  of  the  tip  are  to  be 
controlled  so  that  the  tip  position  remains  at  the  reference  position  X.  and  Y.,  the  control 

is  to  be  provided  by  a  DC  motor  at  the  re  volute  joint  R1.  If  the  disturbance  to  this 
system  results  from  the  motion  excitation  at  the  sliding  joint  DIST,  the  motion  would 
reduce  the  kinematic  degrees  of  freedom  of  the  system  from  3  to  2.  Therefore,  the 
various  transfer  functions  for  this  system  can  be  computed  by  IMP  for  the  vibration 
response  of  the  various  motions  of  interest: 

R1  =  ei.  +  0,(t)  X  =  X.  +  X(t)  Y  =  Y.  +  Y(t)  (7) 


and  the  various  transfer  functions  are  the  complex  ratios: 

0i  Ni  N2  N3  N4 

T  =  sTD7  +  s-D2  +  s-U3  +  s~-U, 

0i  Ai  A2  A3  A4 

DIST  ~  s'-  D,  +  s  -  D2  +  s^Ds  +  s  -  D4 

X  _  B,  B2  B3  B4 

T  s  -  Di  s  -  D2  s  -  D3  s  -  D4 


(8) 


Similarly  for  Y/T,  X/DIST,  and  Y/DIST. 

These  transfer  functions  provide  the  building  blocks  for  fhe  block  diagram  descrip¬ 
tion  of  a  dynamic  system,  including  the  transfer  function  representation  of  the  sensors 
and  of  the  actuators. 


If  a  position  control  system  is  to  be  design  with  a  DC  motor  used  as  the  actuator  at 
the  R1  joint,  the  position  sensors  could  be  placed  at  any  location,  although  good  control 
design  practice  would  dictate  the  location  of  the  sensor  ideally  at  the  place  of  control,  in 
this  case,  the  rotation  of  joint  R1 .  As  an  example,  the  reference  position  0  correspond¬ 
ing  to  the  tip  point  position  X.,  Y.  can  be  directly  controlled.  A  position  sensor,  such  as 

a  resolver,  can  provide  the  position  feedback.  A  typical  block  diagram  representation  of 
the  control  system  is  shown  in  figure  4.  The  transfer  functions  are  computed  at  the 
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reference,  which  in  most  cases  would  be  a  position  of  static  equilibrium.  As  an  ex¬ 
ample,  for  a  specific  set  of  design  parameters  for  the  system  of  figure  3,  the  transfer 
function  relating  the  6  displacement  to  the  torque  T  computed  by  IMP  is: 


0,  0.000358  +  j  0.0001 053  0.000358  +  j  0.0001 053 

T  -  s  :  (-0.595  -Tj  16.985}"  +  s  -  (-0.595  -  j  ■  16.985T 

-0.000358  +  j  0.00777  -0.000358  -  j  0.00777 

+  s  -  (-3.3165  +  j  ■  34.807)  +  s  -  (-373165  -  |  34:807) 

and  the  transfer  function  relating  the  0,  displacement  to  a  harmonic  displacement  at  the 
distrubance  input  of  the  tank  is: 

0,  (0.0017449  +  j  0.0010235)  +  (-0.0000214  +  J  0.00000134)  s2 

DIST  “  s  -  (-0.595  -  j  16.985) 

(0.0017449  -  i  0.0010235)  +  (-0.0000214  -  j  0.00000134)  s2 
+  . . .  ’■  ""  s- (-0.595- j  -  16.985) 

(-0.0017449  -  j  0.043708)  +  (0.0000214  -  j  0.0016884)  •  s2 
+  "  .  s  -  (-3.3165 +  j  34.807) 

(-0.001  7449  +  |  0.043708)  +  (0.000021 4  +  J  0.001 6884)  s2 
+  '  T  s-  (-3.3165  -j  34.807) 

State  Representative  Models 

Transfer  functions  generated  by  IMP  provide  one  method  for  communicating  a 
mechanical  system  model  to  the  control  design  system.  Some  procedures  for  control 
system  synthesis  require  a  state  space  representation  of  the  mechanical  system.  A 
state  space  model,  by  definition,  requires  the  use  of  the  minimum  possible  number  of 
state  variables  to  define  the  system  state.  A  state  space  model  of  the  mechanical 
system  can  be  derived  by  the  following  alternative  methods. 

State  Model  from  Transfer  Function 


For  an  n  degree  of  freedom  mechanical  system,  an  IMP  transfer  function  is 

of  the  form: 


O(S)  _  N)_  N2  N3  _ N2n 

l(S)  S  Di  S  -  D2  S  -  D3  S  -  D2n 


(9) 
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A  typical  pair  is: 

Ni  N2  A,  +j  ■  Bi  A,  -j  Bt  Pi  s  +  Qt 

s-D,  +  s-Do  -  s-|C,  +  j  D,j  4  s-  jCt  -  j  D,j  =  s5  +  R,  s  +  T,  {  } 


where 


P,  =  2  A, 


q,  =  -2  [A,  C,  +  B,  D,] 


R,  =  -2  C, 
T,  =  C?  +  D? 


(11) 


Therefore,  the  IMP  generated  transfer  function  can  be  represented  as  a  summation  of  n 
second  order  systems: 


O(s)  _  Pi  s  +  Qi  P2  +  Q'.  Pn  s  +  Qn 

l(s)  ~  s?  +  R,  s  +  Ti  +  s?  +  R;.  s  +  T2  4  4  s2  +  Rn  s  +  T„ 


The  linear  system  characterized  by  the  transfer  function  of  equation  12  can 
be  represented  as: 


O(s)  _  0(s)i  0(s)2  0(s)„ 

l(s)  "  l(s)  4  l(s)  4  '-4  l(s) 


(13) 


where 


O(s)  -  O(s),  +  O(s),,  +  .  +  0(s)o  (14) 

Again,  a  typical  term  in  the  summation  of  equation  13  is 

0(s)i  _  P(s),  +  Q\  .  g.. 

I(s)  “  s?  +R,  -s  +  T,  (  ) 


therefore, 


O,  4  R,  O,  +  T,  O,  =  P,  I  +  Q,  I  (16) 

Define  two  state  variables  for  this  second  order  system, 

di  q.«  q,  =  -R,  q;.-T,  q,  +  l  (17> 

and  for  the  output  equation,  select 

°i  =  P,  f  °,  d, 
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(18) 


These  state  variables  lead  to  the  original  second  order  system.  A  state 
representation  of  the  second  order  system  of  equation  15  is: 


~q  1 

•  'i- 

Lqd 

To  i  ] 

-T  -R 

1  1 
_ 

\\  +  'O' 

q  .  A 

Lq2. 

1 

(19) 

°,  ■ 

p;  v 

L-q2j 

(20) 

For  an  n  degree  of  freedom  system,  a  state  characterization  from  an  IMP 
generated  transfer  function  is: 


and,  since  O  =  O,  +  0„  +  CL  +  .  .  .  +  O 

i  c  d  n 


0  =  [Ql  P1  P2  -  Qn  Pnl 


<1, 

q2 


'2n 


(22) 
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Also,  since  O  =  O,  +  0„  +  .  .  .  +  O 

12  n 


O  =  [-P  T.  [Q  -  P.  ■  R.j  ] 

f  1  I  I  L  I  I  H  J 


^21  -  1 
L^2i 


+  P  I 


i  =  1, 2, .  .  n 


(23) 


°  =  [-P,  Ti  [0,-P,  R,]  •  -Pn  T  [Qn-PnRJ]  rq,“! 


Lq2nJ 


+  iP1+P2  +  P3  -  Pn]' 


(24) 


Resulting  in 


TCP 

LOj 


r 


qi  pi 

-p,  • T,  (q,  - p,  R,i 


p  i  rq,i 

n  !  i  ^1 


-P  T  Q  -  P  R,i 

n  n  n  n  1 


L^nj 


+  [P,  +  P.  + .  ° .  .  +  Pi  I 


(25) 


Equations  21  and  25  comprise  a  state  characterization  of  the  mechanical 
system.  For  each  output  of  interest  in  a  mechanical  system,  it  is  possible  to  derive  the 
corresponding  state  characterization.  Since  each  output  results  in  a  2n  set  of  state 
variables  as  shown  in  equation  21,  a  multiple  output  system  will  result  in  a  set  of  state 
variables  consisting  of  more  than  the  minimum  number  required  to  define  the  system 
state.  A  matrix  rank  based  approach  to  identify  the  minimum  subsystem  from  the 
original  system  matrix  of  equation  21  is  available  to  MATRIXx  based  on  the  algorithm 

described  in  reference  15.  This  procedure  in  MATRIXx  can  be  used  to  define  the 
minimal  subsystem  and  the  relationship  between  the  original  and  the  new  space. 


10 


A  potential  problem  in  using  transfer  functions  to  create  the  state  space 
models  is  that,  depending  upon  the  specific  outputs  chosen  for  the  transfer  functions,  it 
is  possible  to  either  completely  miss  or  to  minimize  the  importance  of  one  or  more 
modes  of  the  system.  With  appropriate  care,  however,  it  is  possible  to  create  a  valid 
state  representation  of  the  mechanical  system  from  IMP  generated  transfer  functions. 

State  Model  Directly  from  IMP 

Another  method  for  state  space  characterization  of  the  mechanical  system  is 
to  directly  use  the  generalized  coordinate  based  dynamical  formulation  originally  used 
by  IMP  to  compute  the  transfer  functions.  For  an  n  degree  of  freedom  mechanical 
system,  IMP  selects  the  appropriate  generalized  coordinates  based  upon  a  coordinate 
partitioning  scheme.  This  scheme  (ref  16)  identifies  an  independent  set  of  generalized 
coordinates  which  produces  numerically  well-conditioned  computations.  For  an  n 
degree  of  freedom,  with  input  force,  torque,  or  displacement  I,  the  IMP  generated  state 
space  model  is  of  the  form: 

{q}  =  [A}  {q}  +  {B}  I 

(2n  x  1 )  (2nx2n)  (2nx1)  (26) 

The  outputs  of  interest,  such  as  the  x,y,z  displacements  of  a  point  or  the 
displacement  within  a  joint,  are  related  to  the  generalized  coordinates  by  algebraic 
relationships  which  are  computed  by  IMP.  For  example,  for  the  x,y  displacements  of 
the  tip  point  and  for  the  01  displacement  in  the  system  of  figure  3, 

fx]  rct  C2  0  0-  jq,- 

y  '=  d(  d2  0  0  !  q2 

LeJ  Lei  e 2  0  °j  % 

q4j  (27) 

where  cr  c2,  d, ,  d2,  er  e2  are  computed  by  IMP  at  the  reference  position.  Equations  26 
and  27  comprise  a  state  space  representation  of  the  mechanical  system. 

Control  System  Design  in  MATR1Xx 

The  state  space  representation  of  the  mechanical  system  is  then  combined  with 
the  transfer  function  representations  of  the  sensors  and  the  actuators  to  form  a  com¬ 
plete  block  diagram  model  of  the  dynamic  system.  The  block  diagram  is  completed  by 
visually  interconnecting  the  transfer  functions  and  assigning  external  inputs/outputs 
using  the  system  build  function  of  MATRIXx.  Based  on  the  model,  most  classical  and 

modern  design  methodologies  can  be  used  to  develop  a  discrete  time  controller.  This 
controller  is  connected  to  the  IMP-derived  linear  model  to  validate  its  performance  and 
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robustness  characteristics.  One  of  the  key  features  of  this  process  is  that  MATRIXx  can 

produce  an  optimized  FORTRAN,  C,  or  ADA  computer  program  based  on  the  controller 
block  diagram  which  can  be  compiled,  linked,  and  downloaded  to  a  microprocessor. 
The  computer  program,  generated  by  AUTOCODE  and  called  SCHEDULE,  contains 
the  necessary  information  on  such  parameters  as  sampling  rate,  number  of  inputs,  and 
the  number  of  outputs.  The  SCHEDULE  program  samples  the  inputs  at  the  frequency 
defined  by  the  designer  and  calculates  control  outputs  based  on  the  closed  form  control 
law. 

IMP  Simulation  of  Controlled  System 

The  SCHEDULE  program  and  the  associated  routines  produced  by  MATRIXx  will 

now  be  used  to  control  the  original  IMP  model  which  produced  the  linearized  transfer 
functions  of  the  mechanical  system.  The  objective  now  is  to  carry  out  nonlinear  time- 
history  simulations  of  the  controlled  mechanical  system  with  the  SCHEDULE  program 
acting  as  the  digital  controller. 

The  integration  of  IMP  with  the  MATRIXx  generated  SCHEDULE  program  requires 
the  resolution  of  the  following  issues: 

•  The  time  integration  procedure  in  IMP  is  a  variable  step,  stiff  system 
integration  scheme  specifically  develuped  for  internal  IMP  calculations.  IMP’S  integra¬ 
tion  time  step  is  adjusted  to  minimize  the  estimated  error  of  the  numerical  integration 
process  at  each  time  step.  The  sampling  time  for  the  digital  controller  SCHEDULE  is  a 
constant  time  interval  selected  during  the  control  design  process.  The  strategy  devel¬ 
oped  for  the  integrated  use  of  IMP  and  the  SCHEDULE  program  is  to  assign  the  sam¬ 
pling  interval  of  SCHEDULE  as  the  upper  limit  of  the  numerical  integration  time  step.  If 
the  integration  time  step  is  adjusted  by  IMP  to  be  less  than  the  sample  interval  (i.e. , 
between  two  samples),  the  values  of  the  input  sensors  and  the  outputs  are  assigned 
constant  values  of  the  most  recently  sampled  inputs  and  computed  outputs.  This 
interface  is  identical  to  the  behavior  of  a  typical  digital  controller  where  the  inputs  and 
the  outputs  hold  their  values  until  a  new  sample  is  taken. 

•  The  SCHEDULE  program  requires  the  instantaneous  samples  of 
inputs,  or  sensors,  to  compute  the  values  of  the  outputs  based  on  the  control  law  built 
into  the  SCHEDULE  program.  IMP  has  a  well-developed  vocabulary  in  a  user  oriented 
language  for  the  description  of  a  mechanical  system.  The  inputs  and  outputs  required 
by  the  SCHEDULE  program  at  each  sampling  instant  are  directly  defined  within  the  IMP 
problem  model.  For  example,  figure  5  shows  the  IMP  problem  model  for  the  two  mass, 
three  springs  system  used  as  the  illustrative  example  in  this  report.  The  SCHEDULE 
program  in  this  case  needs  four  inputs:  position  of  mass  Ml,  velocity  of  mass  Ml, 
position  of  mass  M2,  and  the  velocity  of  mass  M2.  The  output  from  the  SCHEDULE 
program  is  the  control  force  on  the  mass  Ml;  the  force  is  named  fl.  To  define  the 
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corresponding  sensors  and  actuators  in  IMP,  standard  keywords  are  used.  The  VALUE 
statement  is  necessary  to  interrogate  IMP  for  specific  joint  or  point  variables  (i.e., 
accelerations,  velocities,  positions,  torques,  or  forces).  These  variables  are  convenient 
IMP  key  words  known  as  POSITION,  VELOCITY,  FORCE,  etc. 

The  interface  between  the  IMP  system  and  the  SCHEDULE  program  is  by  a 
standard  USER  subroutine.  This  is  the  subroutine  which  accesses  the  IMP  data  base 
at  the  time  instant  of  the  sample;  the  VALUE  statements  and  their  input  numbers  (e.g., 
11,  12,  13,  etc.)  provide  the  required  definitions  of  the  various  sensor  variables  to  the 
USER  routine.  These  values  are  passed  by  the  USER  routine  to  the  SCHEDULE 
program.  The  output  from  the  SCHEDULE  program,  in  this  case  01 ,  is  assigned  to  the 
instantaneous  value  of  the  force  fl.  This  is  shown  in  figure  5  as  the  two  IMP 
statements: 


value  (01 )  =  user  (101 ) 
data  force  (fl )  =  01 

The  USER  routine  also  checks  the  specific  time  when  the  requests  for  VALUES 
are  initiated  by  IMP.  As  indicated,  IMP  requests  these  values  at  the  adjusted  integration 
time  step;  the  USER  routine  then  decides  whether  to  take  the  additional  sample  and  call 
SCHEDULE  or  to  return  the  values  from  the  previous  sample  based  upon  whether  the 
sample  interval  has  elapsed  from  the  previous  sample,  as  explained  above.  The  USER 
routine,  therefore,  acts  as  a  traffic  manager  for  the  interchange  of  data  between  IMP 
and  SCHEDULE. 

The  IMP  key  word  vocabulary  and  its  capability  to  perform  algebraic  computations 
written  in  FORTRAN  provide  a  powerful  vehicle  to  model  a  variety  of  sensor  inputs. 
Some  examples  already  completed  are:  resolver,  tachometer,  rate  gyro,  angular 
acceleration  sensor,  position  sensor,  velocity  sensor,  and  line  of  sight  sensor. 

Software  for  IMP  and  MATRIXx  Integration 

A  series  of  FORTRAN  modules  have  been  written  to  fully  automate  the  process¬ 
ing,  data,  and  code  transfer  between  IMP  and  MATRIXx  and  vice  versa.  The  following 

describes  the  modules  and  their  functions: 

«  Plotting  Module.  Uses  the  MATRIXx  plotting  capabilities  to  produce 

plots  and  graphs  of  IMP  time-history  results  (i.e.,  displacements,  velocities,  accelera¬ 
tions,  forces,  and  torques  versus  time).  The  IMP  generated  output  files  are  converted  to 
the  MATRIXx  file  format  for  loading  into  MATRIXx.  The  MATRIXx  plotting  capability  is 

routinely  used  during  the  control  system  design  and  analysis  process,  and  it  was  felt 
that  a  consistent  format  of  IMP  and  MATRIXx  plots  would  enhance  the  overall 

CAEE-CMS. 
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•  Transfer  Function  Module.  Conversion  of  the  IMP  generated  transfer  f 
unctions  into  a  state  characterization. 

•  IMP  User  Function  Module.  A  standard  IMP  USER  function  to:  extract 
sensor  data  at  each  instant  of  time;  interface  with  MATR!Xx  generated  control  code 

(SCHEDULE);  and  produce  nonlinear  time-history  dynamics. 

•  Schedule  Modification  Module.  A  software  module  to:  perform  minor 
editing  of  the  MATRIXx  generated  SCHEDULE  and  associated  code;  compile  SCHED¬ 
ULE  and  associated  code,  including  some  dummy  routines  to  replace  the  hardware 
calls  in  an  actual  plant  controller;  and  link  the  compile  code  with  IMP  to  produce  the 
executable  version. 

These  software  modules  comprise  a  key  part  of  the  CAEE-CMS. 


ILLUSTRATIVE  EXAMPLE 

The  complete  integration  of  IMP  and  MATRIXx  is  illustrated  in  figure  5.  The 
displacement  of  mass  Ml  is  Xr  and  of  mass  M2  is  X2.  A  control  force  FI  is  applied  at 

Ml.  This  system  is  a  linear  system  and  the  CAEE-CMS  advocated  in  this  report  is 
directed  toward  nonlinear  mechanical  systems  of  the  type  shown  in  figure  3.  However, 
this  model  simplifies  the  validation  of  the  CAEE-CMS  and  illustrates  the  following  steps 
of  the  integrated  design  process. 

1 .  Development  of  the  IMP  model  for  this  system  and  the  computation  of 
the  transfer  functions:  X^sJ/F^s)  and  X2(s)/F,(s). 

2.  Generation  of  the  state  characterization  model  with  eight  states  in  this 

case. 

3.  MATRIXx  procedure  is  required  to  convert  the  state  characterization 

model  into  a  minimal  space  representation.  The  minimal  procedure  produces  a  state 
space  representation  with  four  states  in  this  case. 

4.  Design  of  a  compensator  for  this  model.  The  model  was  discretized 
and  an  LOG  controller  was  designed.  The  overall  block  diagram  for  the  controlled 
mechanical  system  is  shown  in  figure  6.  A  block  with  a  time  delay  of  0.01  seconds  is 
included  in  the  model  to  account  for  the  computational  time  delay  of  the  controller. 
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5.  AUTOCODE  generation  of  the  controller  program  SCHEDULE  which 
represents  the  finalized  control  law.  This  SCHEDULE  program  is  edited,  compiled,  and 
linked  with  the  IMP  program. 

6.  Validation  of  the  digital  controller  running  on  the  full  nonlinear  IMP 
model  (linear  in  this  case).  The  open  and  closed  loop  responses  of  this  system  to 
nonzero  initial  conditions,  i.e. ,  mass  Ml  displaced  1  inch  to  the  right  and  mass  M2 
displaced  2  inches  to  the  right  is  shown  in  figure  6.  The  results  from  IMP  with  the 
SCHEDULE  code  as  the  controller  are  identical  to  the  results  obtained  from  a  simula¬ 
tion  performed  in  MATRIXx  using  the  same  digital  controller  operating  on  the  continu¬ 
ous  plant  model. 


CONCLUSIONS 

A  prototype  computer-aided  engineering  environment  for  controlled  mechanical 
systems  (CAEE-CMS)  has  been  demonstrated..  The  environment  includes  the  com¬ 
mercially  available  subsystems  for  multibody  dynamics  (IMP),  geometric  modeling  and 
animation  (GMS/LYNX2),  and  control  system  design  (MATRIXx).  The  concept  of 

transfer  functions  is  central  to  the  CAEE-CMS.  This  report  documents  the  current 
status  of  work  in  progress.  The  CAEE-CMS  (fig.  1)  is  the  ultimate  environment  toward 
which  the  current  research  is  progressing. 

The  CAEE-CMS  is  presently  being  used  for  several  applications.  A  helicopter  gun 
turret  system  (fig.  7)  suffers  significant  disturbance  inputs  from  helicopter  vibration,  gun 
firing,  and  structural  flexibility  of  the  gun  supporting  structure  and  gun  barrel.  The 
dynamics  of  this  system  can  vary  significantly  due  to  gun  pointing,  helicopter  configura¬ 
tion,  and  flying  conditions.  The  CAEE-CMS  is  being  used  to  study  the  dynamic  behav¬ 
ior  of  this  system  and  develop  control  algorithms  to  improve  the  accuracy  of  this 
weapon  system. 
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Figure  1 .  Computer  aided  engineering  environment 
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Figure  3.  Example  of  a  constrained  multibody  system 
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Figure  4.  General  block  diagram  representation  of  position  control  system  for  the  constrained  multibody 
system.  (Note  the  role  of  IMP  generated  transfer  functions.) 
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Figure  5.  System  for  demonstration  of  IMP  and  MATRIXx  integration 
with  IMP  program 
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Figure  6.  Results  of  MATRIXx/IMP  analysis  of  system 
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Figure  7.  Helicopter  gun  turret  components 
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